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MOBILITY ASSIST DEVICE 

BACKGROUND OF THE INVENTION 
The present invention deals with mobility 
assistance. More particularly, the present invention 
deals with a vision assist device in the form of a head 
up display (HUD) for assisting mobility of a mobile 
body, such as a person^ non-motorized vehicle or motor 
vehicle . 

Driving a motor vehicle on the road, with a 
modicum of safety, can be accomplished if two different 
aspects of driving are maintained. The first is 
referred to as "collision avoidance" which means 
maintaining motion of a vehicle without colliding with 
other obstacles . The second aspect in maintaining safe 
driving conditions is referred to as "lane keeping" 
which means maintaining forward motion of a vehicle 
without erroneously departing from a given driving lane. 

Drivers accomplish collision avoidance and 
lane keeping by continuously controlling vehicle speed, 
lateral position and heading direction by adjusting the 
acceleration and brake pedals, as well as the steering 
wheel. The ability to adequately maintain both 
collision avoidance and lane keeping is greatly 
compromised when the forward-looking visual field of a 
driver is obstructed. In fact, many researchers have 
concluded that the driver's ability to perceive the 
forward-looking visual field is the most essential input 
for the task of driving. 
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There are many different conditions which can 
obstruct (to varying degrees) the forward-looking visual 
field of a driver. For example, heavy snowfall, heavy 
rain, fog, smoke, darkness, blowing dust or sand, or any 
5 other substance or mechanism which obstructs (either 
partially or fully) the forward-looking visual field of 
a driver makes it difficult to identify obstacles and 
road boundaries which, in turn, compromises collision 
avoidance and lane keeping. Similarly, even on sunny, 

10 or otherwise clear days, blowing snow or complete 
coverage of the road by snow, may result in a loss of 
visual perception of the road. Such "white out" 
conditions are often encountered by snowplows working on 
highways, due to the nature of their task. The driver's 

15 forward-looking vision simply does not provide enough 
information to facilitate safe control of the vehicle. 
This can be exacerbated, particularly on snow removal 
equipment, because even on a relatively calm, clear day, 
snow can be blown up from the front or sides of snowplow 

20 blades, substantially obstructing the visual field of 
the driver. 

Similarly, driving at night in heavy snowfall 
causes the headlight beams of the vehicle to be 
reflected into the driver's forward-looking view. Snow 
25 flakes glare brightly when they are illuminated at night 
and make the average brightness level perceived by the 
driver's eye higher than normal. This higher brightness 
level causes the iris to adapt to the increased 
brightness and, as a result, the eye becomes insensitive 



to the darker objects behind the glaring snowf lakes, 
which are often vital to driving. Such objects can 
include road boundaries, obstacles, other vehicles, 
signs, etc. 

5 Research has also been done which indicates 

that prolonged deprivation of visual stimulation can 
lead to confusion. For example, scientists believe that 
one third of human brain neurons are devoted to visual 
processing. Pilots, who are exposed to an empty visual 
n 10 field for longer than a certain amount of time, such as 

^ during high-altitude flight, or flight in thick fog, 

M= have a massive number of unstimulated visual neurons. 

S This can lead to control confusion which makes it 

y 3 

H difficult for the pilot to control the vehicle. A 

15 similar condition can occur when attempting to navxgate 
J={ or plow a snowy road during daytime heavy snowfall in a 

M: featureless rural environment. 

^ Many other environments are also plagued by 

O poor visibility conditions. For instance, in military 

20 or other environments one may be moving through terrain 
at night, either in a vehicle or on foot, without the 
assistance of lights. Further, in mining environments 
or simply when driving on a dirt, sand or gravel surface 
particulate matter can obstruct vision. In water-going 
25 vehicles, it can be difficult to navigate through 
canals, around rocks, into a port, or through lock and 
dams because obstacles may be obscured by fog, below the 
water, or by other weather conditions. Similarly, 
surveyors may find it difficult to survey land with 
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dense vegetation or rock formations which obstruct 
vision. People in non-motorized vehicles (such as in 
wheelchairs, on bicycles, on skis, etc... can find 
themselves in these environments as well. All such 
5 environments, and many others, have visual conditions 
which act as a hindrance to persons working in, or 
moving through, those environments. 

SUMMARY OF THE INVENTION 

10 The present invention is directed to a visual 

assist device which provides a conformal, augmented 
display to assist in movement of a mobile body. In one 
example, the mobile body is a vehicle (motorized or non- 
motorized) and the present invention assists the driver 

15 in either lane keeping or collision avoidance, or both. 
The system can display lane boundaries, other 
navigational or guidance elements or a variety of 

other objects in proper perspective, to assist the 
driver. In another example, the mobile body is a person 

20 (or group of people) and the present invention assists 
the person in either staying on a prescribed path or 
collision avoidance or both. The system can display 
path boundaries, other navigational or guidance elements 
or a variety of other objects in proper perspective, to 

25 assist the walking person. 
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BRIEF DESCRIPTION OF THE DRAWINGS 
FIG. 1 is a block diagram of a mobility assist 
device in accordance with one embodiment of the present 
invention. 

5 FIGS. 2 is a more detailed block diagrams of 

another embodiment of the mobility assist device. 

FIG. 3A is a partial-pictorial and partial 
block diagram illustrating operation of a mobility 
assist device in accordance with one embodiment of the 
10 present invention. 

FIG. 3B illustrates the concept of a combiner 
and virtual screen. 

FIGS. 3C, 3D and 3E are pictorial 
illustrations of a conformal, augmented projection and 
15 display in accordance with one embodiment of the present 
invention . 

FIGS. 3F, 3G, 3H and 31 are pictorial 
illustrations of an actual conformal, augmented display 
in accordance with an embodiment of the present 
20 invention. 

FIGS. 4A-4C are flow diagrams illustrating 
general operation of the mobility assist device. 

FIG. 5A illustrates coordinate frames used in 
accordance with one embodiment of the present invention. 
25 FIGS. 5B-1 to 5K-3 illustrate the development 

of a coordinate transformation matrix in accordance with 
one embodiment of the present invention. 
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FIG. 6 is a side view of a vehicle employing 
the ranging system in accordance with one embodiment of 
the present invention. 

FIG. 7 is a flow diagram illustrating a use of 
5 the present invention in performing system diagnostics 
and improved radar processing. 

FIG. 8 is a pictorial view of a head up 
virtual mirror, in accordance with one embodiment of the 
present invention . 
10 FIG. 9 is a top view of one embodiment of a 

system used to obtain position information corresponding 
to a vehicle. 

FIG. 10 is a block diagram of another 
embodiment of the present invention. 

15 

DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS 

The present invention can be used with 
substantially any mobile body, such as a human being, a 
motor vehicle or a non-motorized vehicle. However, the 

20 present description proceeds with respect to an 
illustrative embodiment in which the invention is 
implemented on a motor vehicle as a driver assist 
device. FIG. 1 is a simplified block diagram of one 
embodiment of driver assist device 10 in accordance with 

25 the present invention. Driver assist device 10 includes 
controller 12, vehicle location system 14, geospatial 
database 16, ranging system 18, operator interface 20 
and display 22 . 



In one embodiment, controller 12 is a 
microprocessor, microcontroller, digital computer, or 
other similar control device having associated memory 
and timing circuitry. It should be understood that the 
5 memory can be integrated with controller 12, or be 
located separately therefrom. The memory, of course, 
may include random access memory, read only memory, 
magnetic or optical disc drives, tape memory, or any 
other suitable computer readable medium. 

10 Operator interface 20 is illustratively a 

keyboard, a touch- sensitive screen, a point and click 
user input device (e.g. a mouse), a keypad, a voice 
activated interface, joystick, or any other type of user 
interface suitable for receiving user commands, and 

15 providing those commands to controller 12, as well as 
providing a user viewable indication of operating 
conditions from controller 12 to the user. The operator 
interface may also include, for example, the steering 
wheel and the throttle and brake pedals suitably 

20 instrumented to detect the operator's desired control 
inputs of heading angle and speed. Operator interface 
20 may also include, for example, a LCD screen, LEDs, a 
plasma display, a CRT, audible noise generators, or any 
other suitable operator interface display or speaker 

25 unit. 

As is described in greater detail later in the 
specification, vehicle location system 14 determines and 
provides a vehicle location signal, indicative of the 
vehicle location in which driver assist device 10 is 
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mounted, to controller 12. Thus, vehicle location 
system 14 can include a global positioning system 
receiver (GPS receiver) such as a differential GPS 
receiver, an earth reference position measuring system, 
5 a dead reckoning system (such as odometery and an 
electronic compass) , an inert ial measurement unit (such 
as accelerometers, inclinometers, or rate gyroscopes), 
etc. In any case, vehicle location system 14 

periodically provides a location signal to controller 12 

10 which indicates the location of the vehicle on the 
surface of the earth. 

Geospatial database 16 contains a digital map 
which digitally locates road boundaries, lane 
boundaries, possibly some landmarks (such as road signs, 

15 water towers, or other landmarks) and any other desired 
items (such as road barriers, bridges etc..) and 
describes a precise location and attributes of those 
items on the surface of the earth. 

It should be noted that there are many 

20 possible coordinate systems that can be used to express 
a location on the surface of the earth, but the most 
common coordinate frames include longitudinal and 
latitudinal angle, state coordinate frame, and county 
coordinate frame. 

25 Because the earth is approximately spherical 

in shape, it is convenient to determine a location on 
the surface of the earth if the location values are 
expressed in terms of an angle from a reference point. 
Longitude and latitude are the most commonly used angles 




-9- 

to express a location on the earth's surface or in 
orbits around the earth. Latitude is a measurement on a 
globe of location north or south of the equator, and 
longitude is a measurement of the location east or west 
5 of the prime meridian at Greenwich, the specifically 
designated imaginary north-south line that passes 
through both geographic poles of the earth and 
Greenwich, England. The combinations of meridians of 
longitude and parallels of latitude establishes a 
10 framework or grid by means of which exact positions can 

u 

U3 be determined in reference to the prime meridian and the 

m 

=\ equator. Many of the currently available GPS systems 

: 

03 provide latitude and longitude values as location data. 

iLe. Even though the actual landscape on the earth 

— 15 is a curved surface, it is recognized that land is 

p utilized as if it is a flat surface. A Cartesian 

i2 coordinate system whose axes are defined as three 

ffl perpendicular vectors is usually used. Each state has 

q its own standard coordinate system to locate points 

20 within their state boundaries. All construction and 
measurements are done using distance dimensions (such as 
meters or feet) . Therefore, a curved surface on the 
earth needs to be converted into a flat surface and this 
conversion is referred to as a projection. There are 
25 many projection methods used as standards for various 
local areas on the earth's surface. Every projection 
involves some degree of distortion due to the fact that 
a surface of a sphere is constrained to be mapped onto a 
plane . 
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One standard projection method is the Lambert 
Conformal Conic Projection Method. This projection 
method is extensively used in a ellipsoidal form for 
large scale mapping of regions of predominantly east- 
5 west extent, including topographic, quadrangles for many 
of the U.S. state plane coordinate system zones, maps in 
the International Map of the World series and the U.S. 
State Base maps. The method uses well known, and 
publicly available, conversion equations to calculate 

10 state coordinate values from GPS receiver longitude and 
latitude angle data. 

The digital map stored in the geospatial 
database 16 contains a series of numeric location data 
of, for example, the center line and lane boundaries of 

15 a road on which system 10 is to be used, as well as 
construction data which is given by a number of shape 
parameters including, starting and ending points of 
straight paths, the center of circular sections, and 
starting and ending angles of circular sections. While 

20 the present system is described herein in terms of 
starting and ending points of circular sections it could 
be described in terms of starting and ending points and 
any curvature between those points. For example, a 
straight path can be characterized as a section of zero 

25 curvature. Each of these items is indicated by a 
parameter marker, which indicates the type of parameter 
it is, and has associated location data giving the 
precise geographic location of that point on the map. 
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In one embodiment, each road point of the 
digital map in database 16 was generated at uniform 10 
meter intervals. In one embodiment, the road points 
represent only the centerline of the road, and the lane 
5 boundaries are calculated from that centerline point. 
In another embodiment, both the center line and lane 
boundaries are mapped. Of course, geospatial database 
16 also illustratively contains the exact location data 
indicative of the exact geographical location of street 
O 10 signs and other desirable landmarks. Database 16 can be 

obtained by manual mapping operations or by a number of 
jjri automated methods such as, for example, placing a GPS 

m receiver on the lane stripe paint spraying nozzle or 

H tape laying mandrel to continuously obtain locations of 

15 lane boundaries . 
£j Ranging system 18 is configured to detect 

^ targets in the vicinity of the vehicle in which system 

□ 10 is implemented, and also to detect a location (such 

^ as range, range rate and azimuth angle) of the detected 

20 targets, relative to the vehicle. Targets are 

illustratively objects which must be monitored because 
they may collide with the mobile body either due to 
motion of the body or of the object. In one 

illustrative embodiment, ranging system 18 is a radar 
25 system commercially available from Eaton Vorad. 
However, ranging system 18 can also include a passive or 
active infrared system (which could also provide the 
amount of heat emitted from the target) or laser based 
ranging system, or a directional ultrasonic system, or 
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other similar systems. Another embodiment of system 18 
is an infrared sensor calibrated to obtain a scaling 
factor for range, range rate and azimuth which is used 
for transformation to an eye coordinate system. 

Display 22 includes a projection unit and one 
or more combiners which are described in greater detail 
later in the specification. Briefly, the projection 
unit receives a video signal from controller 12 and 
projects video images onto one or more combiners. The 
projection unit illustratively includes a liquid crystal 
display (LCD) matrix and a high- intensity light source 
similar to a conventional video projector, except that 
it is small so that it fits near the driver's seat 
space. The combiner is a partially-reflective, 

partially transmissive beam splitter formed of optical 
glass or polymer for reflecting the projected light from 
the projection unit back to the driver. In one 
embodiment, the combiner is positioned such that the 
driver looks through the combiner, when looking through 
the forward-looking visual field, so that the driver can 
see both the actual outside road scene, as well as the 
computer generated images projected onto the combiner. 
In one illustrative embodiment, the computer-generated 
images substantially overlay the actual images. 

It should also be noted, however, that 
combiners or other similar devices can be placed about 
the driver to cover substantially all fields of view or 
be implemented in the glass of the windshield and 
windows. This can illustratively be implemented using a 
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plurality of projectors or a single projector with 
appropriate optics to scan the projected image across 
the appropriate fields of view. 

Before discussing the operation of system 10 
in greater detail, it is worth pointing out that system 
10 can also, in one illustrative embodiment, be varied, 
as desired. For example, FIG. 2 illustrates that 
controller 12 may actually be formed of first controller 
24 and second controller 26 (or any number of 
controllers with processing distributed among them, as 
desired) . In that embodiment, first controller 24 
performs the primary data processing functions with 
respect to sensory data acquisition, and also performs 
database queries in the geospatial database 16. This 
entails obtaining velocity and heading information from 
GPS receiver and correction system 28. First controller 
24 also performs processing of the target signal from 
radar ranging system 18. 

FIG. 2 also illustrates that vehicle location 
system 14 may illustratively include a differential GPS 
receiver and correction system 2 8 as well as an 
auxiliary inertial measurement unit (IMU) 30 (although 
other approaches would also work) . Second controller 26 
processes signals from auxiliary IMU 30, where 
necessary, and handles graphics computations for 
providing the appropriate video signal to display 22. 

In a specific illustrative embodiment, 
differential GPS receiver and correcting system 28 is 
illustratively a Novatel RT-20 differential GPS (DGPS) 
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system with a 20-centimeter accuracy, while operating at 
a 5 Hz sampling rate or Trimble MS 750 with 2 cm 
accuracy operating at 10 Hz sampling rate. 

FIG. 2 also illustrates that system 10 can 
5 include optional vehicle orientation detection system 31 

f\ and^head tracking system 32. Vehicle orientation 
detection system 31 detects the orientation (such as 
roll and pitch) of the vehicle in which system 10 is 
implemented. The roll angle refers to the rotational 

10 orientation of the vehicle about its longitudinal axis 
(which is parallel to its direction of travel) . The 
roll angle can change, for example, if the vehicle is 
driving over a banked road, or on uneven terrain. The 
pitch angle is the angle that the vehicle makes in a 

15 vertical plane along the longitudinal direction. The 
pitch angle becomes significant if the vehicle is 
climbing up or descending down a hill. Taking into 
account the pitch and roll angles can make the projected 
image more accurate, and more closely conform to the 

20 actual image seen by the driver. 

Optional head tracking system 32 can be 
provided to accommodate for movements in the driver ! s 
head or eye position relative to the vehicle. Of 
course, in one illustrative embodiment, the actual head 

25 and eye position of the driver is not monitored. 
Instead, the dimensions of the cab or operator 
compartment of the vehicle in which system 10 is 
implemented are taken and used, along with ergonomic 
data, such as the height and eye position of an 
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operator, given the dimension of the operator 
compartment, and the image is projected on display 22 
such that the displayed images will substantially 
overlie the actual images for an average operator. 
5 Specific measurements can be taken for any given 
operator as well, such that such a system can more 
closely conform to any given operator. 

Alternatively, optional head tracking system 
32 is provided. Head tracking system 32 tracks the 

10 position of the operator's head, and eyes, in real time. 

FIGS. 3A-3E better illustrate the display of 
information on display 22. FIG. 3A illustrates that 
display 22 includes projector 40, and combiner 42. FIG. 
3A also illustrates an operator 44 sitting in an 

15 operator compartment which includes seat 46 and which is 
partially defined by windshield 48. 

Projector 40 receives the video display signal 
from controller 12 and projects road data onto combiner 
42. Combiner 42 is partially reflective and partially 

20 transmissive . Therefore, the operator looks forward 
through combiner 42 and windshield 48 to a virtual focal 
plane 50. The road data (such as lane boundaries) are 
projected from projector 40 in proper perspective onto 
combiner 42 such that the lane boundaries appear to 

25 substantially overlie those which the operator actually 
sees, in the correct perspective. In this way, when the 
operator's view of the actual lane boundaries becomes 
obstructed, the operator can safely maintain lane 
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keeping because the operator can navigate by the 
projected lane boundaries. 

FIG. 3A also illustrates that combiner 42, in 
one illustrative embodiment, is hinged to an upper 
5 surface or side surface or other structural part 52, of 
the operator compartment. Therefore, combiner 42 can be 
pivoted along an arc generally indicated by arrow 54, up 
and out of the view of the operator, on days when no 
driver assistance is needed, and down to the position 

10 shown in FIG. 3A, when the operator desires to look 
through combiner 42 . 

FIG. 3B better illustrates combiner 42, window 
48 and virtual screen or focal plane 50. Combiner 42, 
while being partially reflective, is essentially a 

15 transparent, optically correct, coated glass or polymer 
lens. Light reaching the eyes of operator 44 is a 
combination of light passing through the lens and light 
reflected off of the lens from the projector. With an 
unobstructed forward-looking visual field, the driver 

20 actually sees two images accurately superimposed 
together. The image passing through the combiner 42 
comes from the actual forward-looking field of view, 
while the reflected image is generated by the graphics 
processor portion of controller 12 . The optical 

25 characteristics of combiner 42 allow the combination of 
elements to generate the virtual screen, or virtual 
focal plane 50, which is illustratively projected to 
appear approximately 30-80 feet ahead of combiner 42. 
This feature results in a virtual focus in front of the 
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vehicle, and ensures that the driver's eyes are not 
required to focus back and forth between the real image 
and the virtual image, thus reducing eyestrain and 
fatigue. 

In one illustrative embodiment, combiner 42 is 
formed such that the visual image size spans 
approximately 30° along a horizontal axis and 15° along a 
vertical axis with the projector located approximately 
18 inches from the combiner. 

Another embodiment is a helmet supported visor 
(or eyeglass device) on which images are projected, 
through which the driver can still see. Such displays 
might include technologies such as those available from 
Kaiser Electro-Optics, Inc. of Carlsbad, CA, The 
MicroOptical Corporation of Westwood, MA, Universal 
Display Corporation of Ewing, NJ, Microvision, Inc. of 
Bothell, WA and IODisplay System LLC of Menlo Park, CA. 

FIGS. 3C and 3D are illustrative displays from 
projector 40 which are projected onto combiner 42. In 
FIGS. 3C and 3D, the left most line is the left side 
road boundary. The dotted line corresponds to the 
centerline of a two-way road, while the right most 
curved line, with vertical poles, corresponds to the 
right-hand side road boundary. The gray circle near the 
center of the image shown in FIG. 3C corresponds to a 
target detected and located by ranging system 18 
described in greater detail later in the application. 
Of course, the gray shape need not be a circle but could 
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be any icon or shape and could be transparent, opaque or 
translucent . 

The screens illustrated in FIGS. 3C and 3D can 
illustratively be projected in the forward-looking 
5 visual field of the driver by projecting them onto 
combiner 42 with the correct scale so that objects 
(including the painted line stripes and road boundaries) 
in the screen are superimposed on the actual objects in 
the outer scene observed by the driver. The black area 

10 on the screens illustrated in FIGS. 3C and 3D appear 
transparent on combiner 42 under typical operating 
conditions. Only the brightly colored lines appear on 
the virtual image that is projected onto combiner 42. 
While the thickness and colors of the road boundaries 

15 illustrated in FIGS. 3C and 3D can be varied, as 
desired, they are illustratively white lines that are 
approximately 1-5 pixels thick while the center line is 
also white and is approximately 1-5 pixels thick as 
well . 

20 FIG. 3E illustrates a virtual image projected 

onto an actual image as seen through combiner 42 by the 
driver. The outline of combiner 42 can be seen in the 
illustration of FIG. 3E and the area 60 which includes 
the projected image has been outlined in FIG. 3E for the 

25 sake of clarity, although no such outline actually 
appears on the display. It can be seen that the display 
generated is a conformal, augmented display which is 
highly useful in low-visibility situations. Geographic 
landmarks are projected onto combiner 42 and are aligned 
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with the view out of the windshield. Fixed roadside 
signs (i.e., traditional speed limit signs, exit 
information signs, etc.) can be projected onto the 
display, and if desired virtually aligned with actual 
5 road signs found in the geospatial landscape. Data 
supporting fixed signage and other fixed items projected 
onto the display are retrieved from geospatial database 
16. 

FIGS. 3F-3H are pictorial illustrations of 
10 actual displays. FIG. 3F illustrates two vehicles in 
close proximity to the vehicle on which system 10 is 
deployed. It can be seen that the two vehicles have 
been detected by ranging system 18 (discussed in greater 
detail below) and have icons projected thereover. FIG. 
15 3G illustrates a vehicle more distant than those in FIG. 
3F. FIG. 3G also shows line boundaries which are 
projected over the actual boundaries. FIG. 3H shows 
even more distant vehicles and also illustrates objects 
around an intersection. For example, right turn lane 
20 markers are shown displayed over the actual lane 
boundaries . 

The presence and condition of variable road 
signs (such as stoplights, caution lights, railroad 
crossing warnings, etc.) can also be incorporated into 
25 the display. In that instance, processor 12 determines, 
based on access to the geospatial database, that a 
variable sign is within the normal viewing distance of 
the vehicle. At the same time, a radio frequency (RF) 
receiver (for instance) which is mounted on the vehicle 



decodes the signal being broadcast from the variable 
sign, and provides that information to processor 12. 
Processor 12 then proceeds to project the variable sign 
information to the driver on the projector. Of course, 
5 this can take any desirable form. For instance, a stop 
light with a currently red light can be projected, such 
that it overlies the actual stoplight and such that the 
red light is highly visible to the driver. Other 
suitable information and display items can be 
^ 10 implemented as well. 

For instance, text of signs or road markers 

01 

yl can be enlarged to assist drivers with poor night 

2 vision. Items outside the driver's field of view can be 

M= displayed (e.g., at the top or sides of the display) to 

^ 15 give the driver information about objects out of view. 

□ Such items can be fixed or transit ionary objects or in 

v. s 
"-si 

u the nature of advertising such as goods or services 

2 available in the vicinity of the vehicle. Such 

Q information can be included in the geospatial database 

20 and selectively retrieved based on vehicle position. 

Directional signs can also be incorporated 
into the display to guide the driver to a destination 
(such as a rest area or hotel), as shown in FIG. 31. It 
can be seen that the directional arrows are superimposed 
25 directly over the lane. 

It should be noted that database 16 can be 
stored locally on the vehicle or queried remotely. 
Also, database 16 can be periodically updated (either 
remotely or directly) with a wide variety of information 
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such as detour or road construction information or any- 
other desired information. 

The presence and location of transitory 
obstacles (also referred to herein as unexpected 
5 targets) such as stalled cars, moving cars, pedestrians, 
etc. are also illustratively projected onto combiner 42 
with proper perspective such that they substantially 
overlie the actual obstacles. Transitory obstacle 
information indicative of such transitory targets or 
10 obstacles is derived from ranging system 18. Transitory 
S obstacles are distinguished from conventional roadside 

: u obstacles (such as road signs, etc.) by processor 12. 

it: Processor 12 senses an obstacle from the signal provided 

y = 

M 1 by ranging system 18. Processor 12, then during its 

T* 15 query of geospatial database 16, determines whether the 

H target indicated by ranging system 18 actually 

corresponds to a conventional, expected roadside 
~ obstacle which has been mapped into database 16. If 

□ not, it is construed as a transitory obstacle, and 

20 projected, as a predetermined geometric shape, or bit 
map, or other icon, in its proper perspective, on 
combiner 42. The transitory targets basically represent 
items which are not in a fixed location during normal 
operating conditions on the roadway. 
25 Of course, other objects can be displayed as 

well. Such objects can include water towers, trees, 
bridges, road dividers, other landmarks,, etc... Such 
P* indicators can also be warnings^or alarms such as not to 
turn the wrong way on a one-way road or an off ramp, 
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that the vehicle is approaching an intersection or work 
zone at too high a high rate of speed. Further, where 
the combiner is equipped with an LCD film or embedded 
layer, it can perform other tasks as well. Such tasks 
5 can include the display of blocking templates which 
block out or reduce glare from the sun or headlights 
from other cars. The location of the sun can be 
computed from the time, and its position relative to the 
driver can also be computed (the same is true for cars) . 
f=i 10 Therefore, an icon can simply be displayed to block the 

undesired glare. Similarly, the displays can be 
,U integrated with other operator perceptible features, 

~ such as a haptic feedback, sound, seat or steering wheel 

vibration, etc. 

15 FIGS. 4A-4C illustrate the operation of system 

H 10 in greater detail. FIG. 4A is a functional block 

diagram of a portion of system 10 illustrating software 
2 components and internal data flow throughout system 10. 

□ FIG. 4B is a simplified flow diagram illustrating 

20 operation of system 10, and FIG. 4C is a simplified flow 
diagram illustrating target filtering in accordance with 
one embodiment of the present invention. 

It is first determined whether system 10 is 
receiving vehicle location information from its primary 
25 vehicle location system. This is indicated by block 62 
in FIG. 4B. In other words, where the primary vehicle 
location system constitutes a GPS receiver, this signal 
may be temporarily lost. The signal may be lost, for 
instance, when the vehicle goes under a bridge, or 
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s imply goes through a pocket or area where GPS or 
correction signals can not be received or is distorted. 
If the primary vehicle location signal is available, 
that signal is received as indicated by block 64. If 
not, system 10 accesses information from auxiliary 
inertial measurement unit 30. 

Auxiliary IMU 30 may, illustratively, be 
complimented by a dead reckoning system which utilizes 
the last known position provided by the GPS receiver, as 
well as speed and angle information, in order to 
determine a new position. Receiving the location signal 
from auxiliary IMU 30 is illustrated by block 66. 

In any case, once system 10 has received the 
vehicle location data, system 10 also optionally 
receives head or eye location information, as well as 
optional vehicle orientation data. As briefly discussed 
above, the vehicle orientation information can be 
obtained from a roll rate gyroscope 68 to obtain the 
roll angle, and a tilt sensor 70 (such as an 
accelerometer) to obtain the pitch angle as well as a 
yaw rate sensor 69 to obtain yaw angle 83. Obtaining 
the head or eye location data and the vehicle 
orientation data are illustrated by optional blocks 72 
and 74 in FIG. 4B. Also, the optional driver's eye data 
is illustrated by block 76 in FIG. 4A, the vehicle 
location data is indicated by block 78, and the pitch 
and roll angles are indicated by blocks 80 and 82, 
respectively. 
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A coordinate transformation matrix is 
constructed, as described in greater detail below, from 
the location and heading angle of the moving vehicle, 
and from the optional driver 1 s head or eye data and 
5 vehicle orientation data, where that data is sensed. 
The location data is converted into a local coordinate 
measurement using the transformation matrix, and is then 
fed into the perspective projection routines to 
calculate and draw the road shape and target icons in 
_ 10 the computer's graphic memory. The road shape and 

ifl target icons are then projected as a virtual view in the 

driver's visual field, as illustrated in FIG. 3B above. 

The coordinate transformation block transforms 
the coordinate frame of the digital map from the global 
15 coordinate frame to the local coordinate frame. The 
local coordinate frame is a moving coordinate frame that 
is illustratively attached to the driver's head. The 
coordinate transformation is illustratively performed by 
multiplying a four-by-four homogeneous transformation 
20 matrix to the road data points although any other 
coordinate system transformations can be used, such as 
the Quaternion or other approach. Because the vehicle 
is kept moving, the matrix must be updated in real time. 
Movement of the driver's eye that is included in the 
25 matrix is also measured and fed into the matrix 
calculation in real time. Where no head tracking system 
32 is provided, then the head angle and position of the 
driver's eyes are assumed to be constant and the driver 
is assumed - tobc « looking forward from a nominal position. 
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The heading angle of the vehicle is estimated 
from the past history of the GPS location data. 
Alternatively, a rate gyroscope can be used to determine 
vehicle heading as well. An absolute heading angle is 
5 used in computing the correct coordinate transformation 
matrix. As noted initially, though heading angle 
estimation by successive differentiation of GPS data can 
be used, any other suitable method to measure an 
absolute heading angle can be used as well, such as a 
g 10 magnetometer (electronic compass) or an inertial 

5ff measurement unit. Further, where pitch and roll sensors 

N= are not used, these angles can be assumed to be 0. 

=S In any case, after the vehicle position data 

H 78 is received, the ranging information from ranging 

s" 15 system 18 is also received by controller 12 (shown in 

j=; FIG. 2) . This is indicated by blocks 83 in FIG. 4A and 

M= by block 86 in FIG. 4B. The ranging data illustratively 

~. indicates the presence and location of targets around 

C the vehicle. For example, the radar ranging system 18 

20 developed and available from Eaton Vorad, or Delphi, 
Celsius Tech, or other vendors provides a signal 
indicative of the presence of a radar target, its range, 
its range rate and the azimuth angle of that target with 
respect to the radar apparatus . 
25 Based on the position signal, controller 12 

queries the digital road map in geospatial database 16 
and extracts local road data 88. The local road data 
provides information with respect to road boundaries as 
seen by the operator in the position of the vehicle, and 
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also other potential radar targets, such as road signs, 
road barriers, etc. Accessing geospatial database 16 
(which can be stored on the vehicle and receive periodic 
updates or can be stored remotely and accessed 
5 wirelessly) is indicated by block 90 in FIG. 4B. 

Controller 12 determines whether the targets 
indicated by target data 83 are expected targets. 
Controller 12 does this by examining the information in 
geospatial database 16. In other words, if the targets 
q 10 correspond to road signs, road barriers, bridges, or 

^ other information which would provide a radar return to 

U ranging system 18, but which is expected because it is 

mapped into database 16 and does not need to be brought 
M- to the attention of the driver, that information can be 

s 15 filtered out such that the driver is not alerted to 

^ every single possible item on the road which would 

M provide a radar return. Certain objects may a priori be 

pj programmed to be brought to the attention of the driver. 

O Such items may be guard rails, bridge abutments, etc... 

20 and the filtering can be selective, as desired. If, for 
example, the driver were to exit the roadway, all 
filtering can be turned off so all objects are brought 
to the driver's attention. The driver can change 
filtering based on substantially any predetermined 
25 filtering criteria, such as distance from the road or 
driver, location relative to the road or the driver, 
whether the objects are moving or stationary, or 
substantially any other criteria. Such criteria can be 
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invoked by the user through the user interface, or they 
can be pre-programmed into controller 12 . 

However, where the geospatial database does 
not indicate an expected target in the present location, 
5 then the target information is determined to correspond 
to an unexpected target, such as a moving vehicle ahead 
of the vehicle on which system 10 is implemented, such 
as a stalled car or a pedestrian on the side of the 
road, or some other transitory target which has not been 

10 mapped to the geospatial database as a permanent, or 
expected target. It has been found that if all expected 
targets are brought to the operator 1 s attention, this 
substantially amounts to noise such that when real 
targets are brought to the operator's attention, they 

15 are not as readily perceived by the operator. 
Therefore, filtering of targets not posing a threat to 
the driver is performed as is illustrated by block 92 in 
FIG. 4B. 

Once such targets have been filtered, the 
20 frame transformation is performed using the 
transformation matrix. The result of the coordinate 
frame transformation provides the road boundary data, as 
well as the target data, seen from the driver's eye 
perspective. The road boundary and target data is 
25 output, as illustrated by block 94 in FIG. 4B, and as 
indicated by block 96 in FIG. 4A. Based on the output 
road and target data, the road and target shapes are 
generated by processor 12 for projection in the proper 
perspective . 
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Generation of road and target shapes is 
illustrated by block 98 in FIG. 4A, and the perspective 
projection is illustrated by blocks 100 in FIG. 4A and 
102 in FIG. 4B. 

5 It should also be noted that the actual image 

projected is clipped such that it only includes that 
part of the road which would be visible by the operator 
with an unobstructed forward-looking visual field. 
Clipping is described in greater detail below, and is 

10 illustrated by block 104 in FIG. 4A. The result of the 
entire process is the projected road and target data as 
illustrated by block 106 in FIG. 4A. 

FIG. 4C is a more detailed flow diagram 
illustrating how targets are projected or filtered from 

15 the display. First, it is determined whether ranging 
system 18 is providing a target signal indicating the 
presence of a target. This is indicated by block 108. 
If so, then when controller 12 accesses geospatial 
database 16, controller 12 determines whether sensed 

20 targets correlate to any expected targets. This is 
indicated by block 110. If so, the expected targets are 
filtered from the sensed targets. It should be noted 
that ranging system 18 may provide an indication of a 
plurality of targets at any given time. In that case, 

25 only the expected targets are filtered from the target 
signal. This is indicated by block 112. If any targets 
remain, other than the expected targets, the display 
signal is generated in which the unexpected, or 
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transitory, targets are placed conformally on the 
display. This is indicated by block 114. 

Of course, the display signal is also 
configured such that guidance markers (such as lane 
boundaries, lane striping or road edges) is also placed 
conformally on the display. This is indicated by block 
116. The display signal is then output to the projector 
such that the conformal, augmented display is provided 
to the user. This is indicated by block 118. 

It can thus be seen that the term "conformal" 
is used herein to indicate that the "virtual image" 
generated by the present system projects images 
represented by the display in a fashion such that they 
are substantially aligned, and in proper perspective 
with, the actual images which would be seen by the 
driver, with an unobstructed field of view. The term 
"augmented", as used herein, means that the actual image 
perceived by the operator is supplemented by the virtual 
image projected onto the head up display. Therefore, 
even if the driver's forward-looking visual field is 
obstructed, the augmentation allows the operator to 
receive and process information, in the proper 
perspective, as to the actual objects which would be 
seen with an unobstructed view. 

A discussion of coordinate frames, in greater 
detail, is now provided for the sake of clarity. There 
are essentially four coordinate frames used to construct 
the graphics projected in display 22. Those coordinate 
frames include the global coordinate frame, the vehicle- 
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attached coordinate frame, the local or eye coordinate 
frame, and the graphics screen coordinate frame. The 
position sensor may be attached to a backpack or helmet 
worn by a walking person in which case this would be the 
vehicle-attached coordinate frame. The global 

coordinate frame is the coordinate frame used for road 
map data construction as illustrated by FIG. 5A. The 
global coordinate frame is illustrated by the axes 120. 
All distances and angles are measured about these axes. 
FIG. 5A also shows vehicle 124, with the vehicle 
coordinate frame represented by axes 126 and the user's 
eye coordinate frame (also referred to as the graphic 
screen coordinate frame) illustrated by axes 128. FIG. 
5A also shows road point data 130, which illustrates 
data corresponding to the center of road 132. 

The capital letters "X", »Y" and "Z" in this 
description are used as names of each axis. The 
positive Y-axis is the direction to true north, and the 
positive X-axis is the direction to true east in global 
coordinate frame 120. Compass 122 is drawn to 
illustrate that the Y-axis of global coordinate frame 
120 points due north. The elevation is defined by the 
Z-axis and is used to express elevation of the road 
shape and objects adjacent to, or on, the road. 

All of the road points 130 stored in the road 
map file in geospatial database 16 are illustratively 
expressed in terms of the global coordinate frame 120. 
The vehicle coordinate frame 126, (V) is defined and 
used to express the vehicle configuration data, 
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including the location and orientation of the driver's 
eye within the operator compartment, relative to the 
origin of the vehicle. The vehicle coordinate frame 126 
is attached to the vehicle and moves as the vehicle 
5 moves. The origin is defined as the point on the ground 
under the location of the GPS receiver antenna. 
Everything in the vehicle is measured from the ground 
point under the GPS antenna. Other points, such as 
located on a vertical axis through the GPS receiver 
10 antenna or at any other location on the vehicle, can 
yp also be selected. 

fV The forward moving direction is defined as the 

ffl positive y-axis. The direction to the right when the 

U vehicle is moving forward is defined as the positive x- 

i - : 

15 axis, and the vertical upward direction is defined as 

□ the positive z-axis which is parallel to the global 

ij; coordinate frame Z-axis. The yaw angle, i.e. heading 

ffl angle, of the vehicle, is measured from true north, and 

D .... 

B has a positive value in the clockwise direction (since 

20 the positive z-axis points upward) . The pitch angle is 
measured about the x-axis in coordinate frame 126 and 
the roll angle is measured as a rotation about the y- 
axis in coordinate frame 126. 

The local L- coordinate frame 128 is defined 

25 and used to express the road data relative to the 
viewer's location and direction. The coordinate system 
128 is also referred to herein as the local coordinate 
frame. Even though the driver's eye location and 
orientation may be assumed to be constant (where no head 
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tracking system 30 is used) the global information still 
needs to be converted into the eye -coordinate frame 128 
for calculating the perspective projection. The 
location of the eye, i.e. the viewing point, is the 
origin of the local coordinate frame. The local 
coordinate frame 128 is defined with respect to the 
vehicle coordinate frame. The relative location of the 
driver's eye from the origin of the vehicle coordinate 
frame is measured and used in the coordinate 
transformation matrix described in greater detail below. 
The directional angle information from the driver's line 
of sight is used in constructing the projection screen. 
This angle information is also integrated into the 
coordinate transformation matrix. 

Ultimately, the objects in the outer world are 
drawn on a flat two-dimensional video projection screen 
which corresponds to the virtual focal plane, or virtual 
screen 50 perceived by human drivers. The virtual 
screen coordinate frame has only two axes. The positive 
x-axis of the screen is defined to be the same as the 
positive x-axis of the vehicle coordinate frame 12 6 for 
ease in coordinate conversion. The upward direction in 
the screen coordinate frame is the same as the positive 
z-axis and the forward-looking direction (or distance to 
the objects located on the visual screen) is the 
positive y-axis. The positive x-axis and the y-axis in 
the virtual projection screen 50 are mapped to the 
positive x-axis and the negative y-axis in computer 
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memory space, because the upper left corner is deemed to 
be the beginning of the video memory. 

Road data points including the left and right 
edges, which are expressed with respect to the global 
5 coordinate frame {G} as Pk, shown in Figure 5B-1, are 
converted into the local coordinate frame {L} which is 
attached to the moving vehicle 124 coordinate frame {v} . 
Its origin (Ov) and direction (9v) are changing 
continually as the vehicle 124 moves. The origin (0 L ) 

10 of the local coordinate frame {l}, i.e. driver's eye 
location, and its orientation (9 E ) change as the driver 
moves his or her head and eyeballs. Even though the 
driver's orientation (0 E ) can be assumed as constant for 
a simplified embodiment of system 10, all of the 

15 potential effects are considered in the coordinate 
transformation equations below for a more detailed 
illustrative embodiment of system 10. All road data 
that are given in terms of the global coordinate frame 
{G} ultimately need to be converted into the eye 

20 coordinate frame {L} . Then they are projected into the 
video screen 22 using a perspective transformation. 

A homogeneous transformation matrix [T] was defined 
and used to convert the global coordinate data into 
25 local coordinate data. The matrix [T] is developed 
illustratively, as follows. 

The parameters in Figures 5B-1 and 5B-2 are as follows: 
• Pk is the k-th road point; 
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• 0 G is the origin of the global coordinate frame; 

• 0 V is the origin of the vehicle coordinate frame with 
respect to the global coordinate frame; and 

• 0 E is the origin of the local eye-attached coordinate 
frame . 

Any point in 3 -dimensional space can be expressed 
in terms of either a global coordinate frame or a local 
coordinate frame . Because everything seen by the driver 
is defined with respect to his or her location and 
viewing direction (i.e. the relative geometrical 
configuration between the viewer and the environment) 
all of the viewable environment should be expressed in 
terms of a local coordinate frame. Then, any objects or 
line segments can be projected onto a flat surface or 
video screen by means of the perspective projection. 
Thus, the mathematical calculation of the coordinate 
transformation is performed by constructing the 
homogenous transformation matrix and applying the matrix 
to the position vectors. The coordinate transformation 
matrix [T] is defined as a result of the multiplication 
of a number of matrices described in the following 
paragraphs . 

To change the global coordinate data to the local 
coordinate data, the translation and rotation of the 
frame should be considered together. The translation of 
the coordinate frame transforms point data using the 
following matrix equation (with reference to FIG. 5C) : 




-35- 

x=X-OlX 
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or L P=WJPP Eq. 2 
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Eq. 3 



The letter G P is a point in terms of coordinates X, 
Y, Z as referenced from the global coordinate system. 
15 The letter represents the same point in terms of x, y, 
z in the local coordinate system. The transformation 

matrix ofo™] allows for a translational transformation 
from the global G coordinate system to the local L 
coordinate system. 
20 The rotation of the coordinate frame about the Z- 

axis can be expressed by the following matrix equation 
(with respect to FIG. 5D) : 
x = X cosG +Ysin0 
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y = -X sin0 +Ycos0 
z = Z 



Eq. 4 



or, in matrix form 



X 




"cos0 sin0 0 0" 


'X~ 




y 




-sin0cos0 0 0 


Y 












Eq 


z 




0 0 10 


Z 


1 




0 0 0 1 


1 





10 



This equation can be written using the following matrix 
equation, 

L P=o[Tj G P Eq. 6 

where, the rotational transformation from the G to the L 
coordinate system is 

"cos0 sin# 0 0" 



L o[Tj = 



-sinO cos0 0 0 
0 0 10 
0 0 0 1 



Eq. 7 



15 For rotation and translation at the same time, these two 
matrices can be combined by the following equations, 



L p= L o[TfP 



Eq. 8 



where 



20 L G [T]= L o 
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Eq. 9 



costf sin0 0 -O L Xcos0-O L Ysme 

-sine cos0 0 0 L X sine -0 L Y cos0 

0 0 1 -0 L Z 

0 0 0 1 



This relationship can be expanded through the {G}, 
5 and {v} , and {l} coordinate frames. The coordinate 
transform matrix [T] was defined as follows assuming 
that only heading angles 0 E and 9 V are considered as 
rotational angle data; 

10 L p=l[Tj i [T¥P=[TTP Eq. 10 

where , 
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[T] = 



C E S E 0 -0 L XC E -0 L YS B 
-S E C E 0 +0 L XS E -0 L YC B 
0 0 1 
0 0 0 1 



Eq. 11 
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and, 



20 



c E = cose E ,s E = sine E> c y = cos^, and s v = sin$ y 
c E+y = cos(e E +e y \ and s E+y = sin(0 E +0 y ) 



Eq. 12 
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The resultant matrix [T] is then as follows 



[r]= 



[ 11 M2 J 13 M4 



l 22 



[ 23 '24 



[ 32 J 33 



[ 41 J 42 



[ 43 



[ 34 



1 44 



where, 



= c e c v ~ s e s v = cos(0 ff + ^ ) 



Eq. 13 



Eq. 14 
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Eq. 15 

Eq. 16 

Eq. 17 

c E {-O v Xc v -O y Ys y )=s B (-O y Xs v -O y Yc y )+{-0 L Xc E -OJs E ) 
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Eq. 20 
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T =0 
T =0 

J 43 U 



1 44 1 



Eq. 27 
Eq. 28 
Eq. 29 



By multiplying the road points P by the [T] matrix, 
we will have local coordinate data p. The resultant 
^ local coordinate value p is then fed into the 

yj 10 perspective projection routine to calculate the 

projected points on the heads up display screen 22. The 
~* calculations for the perspective projection are now 

discussed. 

After the coordinate transformation, all the road 
data are expressed with respect to the driver's viewing 
location and orientation. These local coordinate data 
are illustratively projected onto a flat screen (i.e., 
the virtual screen 50 of heads up display 22) . Shown in 
FIGS. 5E-1 to 5F-3) . 

Projecting the scene onto the display screen can be 
done using simple and well-known geometrical mathematics 
and computer graphics theory. Physically, the display 
25 screen is the virtual focal plane. Thus, the display 
screen is the plane, which is located at S y position, 
parallel to the z-x plane, where s x , s z are the 
horizontal and vertical dimensions of the display 
screen. Where the object is projected onto the screen, 
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it should be projected with the correct perspective so 
that the projected images match with the outer scene. It 
is desirable that the head up display system match the 
drawn road shapes (exactly or at least closely) the 
5 actual road which is in front of the driver. The 
perspective projection makes closer objects appear 
larger and further objects appear smaller. 
The prospective projection can be calculated from 
triangle similarity as shown in FIGS. 5G to 5H-2. From 
10 the figures, one can find the location of the point 
s(x,z) for the known data p(x,y,z). 

The values of s x and s z can be found by similarity 
of triangles . 

Py'-Sy=Px'- S x EC I- 30 
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so, 



S *=Px — 

Py 



Eq. 31 



20 s z = p z — Eq. 32 

Py 

As expected, s x and s 2 are small when the value py 
is big (i.e. when the object is located far away). This 
is the nature of perspective projection. 
25 After calculating the projected road point on the 

display screen by the prospective projection, the points 
are connected using straight lines to build up the road 
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shapes . The line-connected road shape provides a better 
visual cue of the road geometry than plotting just a 
series of dots. 

The road points that have passed behind the 
5 driver's moving position do not need to be drawn. 
Furthermore, because the projection screen has limited 
size, only road points and objects that fall within the 
visible field of view need to be drawn on the projection 
screen. Finding and then not attempting to draw these 

10 points outside the field of view can be important in 
order to reduce the computation load of controller 12 
and to enhance the display refresh speed. 

The visible limit is illustrated by FIGS. 51 to 5J- 
3. The visible three-dimensional volume is defined as a 

15 rectangular cone cut at the display screen. Every object 
in this visible region needs to be displayed on the 
projection screen. Objects in the small rectangular cone 
defined by 0 L and the display screen, a three 
dimensional volume space between the viewer's eye and 

20 the displaying screen, is displayed in an enlarged size. 
If the object in this region is too close to the viewer, 
then it results in an out of limit error or a divide by 
zero error during the calculation. However, usually 
there are no objects located in the "enlarging space." 

25 Figures 5J-1 to 5 J- 3 and the following equations of 
lines were used for checking whether an object is in the 
visible space or not. Using these clipping techniques, 
if the position of a point in the local coordinate frame 
is defined as p(x, y, z) then this point is visible to 
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the viewer only if: 



• the point p is in front of the y = +c 2 x plane (which 
is marked as dark in the top view diagram of Figure 

5 5J-1) ; 

• the point p is in front of the y = -c 2 x plane; 

• the point p is in front of the y = +c 2 z plane (the 
dark region in the right hand side view diagram of 
Figure 5J-3) ; 

10 • the point p is in front of the y = -c 2 z plane; and 

• the point p is in front of the display screen. 

Equations in the diagram of Figure 5J-1 to 5J- 
3 (e.g. y = +c 2 x) are not line-equations but equations of 
15 planes in 3 dimensional space. The above conditions can 
be expressed by the following equations mathematically, 
which describe what we mean by "in front of" 



p y >+ c xP x E q- 33 

20 P y >-c x p x Eq. 34 

P y >+ c 2Pz Eq. 35 

P y >~ c 7Pz Eq. 36 

and 

p y >s y Eq. 37 

25 Only those points that satisfy all of the five 
conditions are in the visible region and are then drawn 
on the projection screen. 
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In some cases, there could be a line segment of the 
road whose one end is in the visible region and the 
other is out of the visible region. In this case, the 
visible portion of the line segment should be calculated 
5 and drawn on the screen. Figures 5K-1 to 5K-3 show one 
of many possible situations. Figure 5K-1 is a top view, 
which is a projection of the xy plane. It will now be 
described how to locate point p so that only the 
contained segment is drawn. 
10 The range of the ratio value k marked as the 

distance between point p and p 2 is from 0.0 to 1.0. The 
position of point p can be written as, 
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Eq. 38 



where, 



k is an arbitrary real number, (0 < k < 1) and 

Pl= (Pi*/ Ply/ Plz)/P2= (P2x, P2y/ P2z), and 
20 Ap = p 2 - p } = (p 2 x-Plx; P2y-Ply, P2z"Plz) 

The x and y components of the above equation can be 
written as follows: 



25 



P X =Plx+ f <ty X 

Py = Ply + k&P y 



Eq. 39 
Eq. 40 
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The x and y components of point p also should satisfy 
the line equation y = +Cix in order to intersect with 
the line. Therefore, 

P y = P iy +kAp y =c i (p lx + kAp x )=c i p ix + kc l Ap x Eq. 41 

k(^P y -c^ x )=c x p u -p Xy Eq. 42 

then, 



<hP\x ~ Py 



Eq. 43 



10 Applying the value k to the above equation p x , p y and p z 
can be determined as follows, 

P*=Pix+*Px- A 7^ E q. 44 

&Py- C lAPx 



- r- .A C \P\x P\y _, „ _ 

15 P y = Piy+APy- 7^ Eq . 45 

* Ap -c,Ap x 



P.=H.+l#, t ™'~*> Eq. 46 



Using these values of p x< p y and p z , the projected 
20 values s x and s z can be calculated by a perspective 
projection in the same manner as the other parameters. 



FIG. 6 illustrates a vehicle 200 with 
placement of ranging system 18 thereon. Vehicle 200 is, 
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illustratively, a snow plow which includes an operator 
compartment 202 and a snow plow blade 204. Ranging 
system 18, in the embodiment illustrated in FIG. 6, 
includes a first radar subsystem 206 and a second radar 
5 subsystem 208. It can be desirable to be able to locate 
targets closely proximate to blade 204. However, since 
radar subsystems 206 and 208 are directional, it is 
difficult, with one subsystem, to obtain target coverage 
close to blade 204, yet still several hundred meters 
_ 10 ahead of vehicle 200, because of the placement of blade 

5 204. Therefore, in one embodiment, the two subsystems 

206 and 208 are employed to obtain ranging system 18. 

===== 

CO Radar subsystem 208 is located just above blade 2 04 and 

Z± is directed approximately straightforwardly, in a 

^ 15 horizontal plane. Radar subsystem 206 is located above 

q blade 204 and is directed downwardly, such that targets 

J; can be detected closely proximate the front of blade 

ffl 204. The radar subsystems 206 and 208 are each 

S illustratively an array of aligned radar detectors which 

20 is continuously scanned by a processor such that radar 
targets can be detected, and their range, range rate and 
azimuth angle from the radar subsystem 206 or 208 can be 
estimated as well. In this way, information regarding 
the location of radar targets can be provided to 
25 controller 12 such that controller 12 can display an 
icon or other visual element representative of the 
target on the head up display 22. Of course, the icon 
can be opaque or transparent . 



It should also be noted that, while the target 
illustrated in FIG. 3C is round, and could represent a 
pedestrian, a vehicle, or any other radar target, the 
icon representative of the target can be shaped in any 
desirable shape. In addition, bit maps can be placed on 
the head up display 22 which represent targets. 
Further, targets can be small, colored or otherwise 
coded to indicate distance. In other words, if the 
targets are very close to vehicle 200, they can be 
large, begin to flash, or turn red. Similarly, if the 
targets are a long distance from vehicle 2 00, they can 
maintain a constant glow or halo. 

FIG. 7 is a flow diagram illustrating how 
ranging system 18 can be used, in combination with the 
remainder of the system, to verify operation of the 
subsystems. First, controller 12 receives a position 
signal. This is indicated by block 210. This is the 
signal, illustratively, from the vehicle location system 
14. Controller 12 then receives a ranging signal, as 
indicated by block 212 in Figure 7. This is the signal 
from ranging system 18 which is indicative of targets 
located within the ranging field of vehicle 200. Next, 
controller 12 queries geospatial database 16. This is 
indicated by block 214. In querying geospatial database 
16, controller 12 verifies that targets, such as street 
signs, road barriers, etc. are in the proper places, as 
detected by the signal received by ranging system 18 in 
block 212. If the targets identified by the target 
signal correlate to expected targets in geospatial 
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database 16 given the current position of the vehicle, 
then controller 12 determines that system 10 is 
operating properly. This is indicated by block 216 and 
218. In view of this determination, controller 12 can 
5 provide an output to user interface 20 indicating that 
the system is healthy. 

If, however, the detected targets do not 
correlate to expected targets in the geospatial database 
for the current vehicle position, then controller 12 

10 determines that something is not operating correctly, 
either the ranging system 18 is malfunctioning, the 
vehicle positioning system is malfunctioning, 
information retrieval from the geospatial database 16 is 
malfunctioning or the geospatial database 16 has been 

15 corrupted, etc. In any case, controller 12 

illustratively provides an output to user interface (UI) 
20 indicating a system problem exists. This is 
indicated by block 220. Therefore, while controller 12 
may not be able to detect the exact type of error which 

20 is occurring, controller 12 can detect that an error is 
occurring and provide an indication to the operator to 
have the system checked or to have further diagnostics 
run. 

It should also be noted that the present 
25 invention need not be provided only for the forward- 
looking field of view of the operator. Instead, the 
present system 10 can be implemented as a side- looking 
or rear- looking virtual mirror. In that instance, 
ranging system 18 includes radar detectors (or other 
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similar devices) located on the sides or to the rear of 
vehicle 200. The transformation matrix would be 
adjusted to transform the view of the operator to the 
side looking or rear looking, field of view as 
5 appropriate . 

Vehicles or objects which are sensed, but 
which are not part of the fixed geospatial landscape are 
presented iconically based on the radar or other range 
sensing devices in ranging system 18. The fixed lane 
10 boundaries, of course, are also presented conformally to 
the driver. Fixed geospatial landmarks which may be 
r? relevant to the driver (such as the backs of road signs, 

W special pavement markings, bridges being passed under, 

y, watertowers, trees, etc.) can also be presented to the 

fea 15 user, in the proper prospective. This gives the driver 

Q a sense of motion as well as cues to proper velocity. 

i2 One illustration of the present invention as 

60 both a forward looking driver assist device and one 

g which assists in a rear view is illustrated in Figure 8. 

20 A forward-looking field of view is illustrated by block 
250 while the virtual rear view mirror is illustrated by 
block 252. It can be seen that the view is provided, 
just as the operator would see when looking in a 
traditional mirror. It should also be noted that the 
25 mirror may illustratively be virtually gimbaled along 
any axis (i.e., the image is rotated from side-to-side 
or top- to-bottom) in software such that the driver can 
change the angle of the mirror, just as the driver 
currently can mechanically, to accommodate different 
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driver sizes, or to obtain a different view than is 
currently being represented by the mirror. 

Figure 9 gives another illustrative embodiment 
of a vehicle positioning system which provides vehicle 
5 position along the roadway. The system illustrated in 
Figure 9 can, illustratively, be used as the auxiliary 
vehicle positioning system 30 illustrated in Figure 2A. 
This can provide vehicle positioning information when, 
for example, the DGPS signal is lost, momentarily, for 

10 whatever reason. In the embodiment illustrated in Figure 
9, vehicle 200 includes an array of magnetic sensors 
260. The road lane 262, is bounded by magnetic strips 
2 64 which, illustratively, are formed of tape having 
magnetized portions 266 therein. Although a wide 

15 variety of such magnetic strips could be used, one 
illustrative embodiment is illustrated in U.S. Patent 
No. 5,853,846 to the 3M Company of St. Paul, Minnesota. 
The magnetometers in strip 260 are monitored such that 
the field strength sensed by each magnetometer is 

20 identified. Therefore, as the vehicle approaches strip 
260 and begins to cross lane boundary 268, magnetometers 
270 and 272 begin to provide a signal indicating a 
larger field strength. 

Scanning the array of magnetometers is 

25 illustratively accomplished using a microprocessor which 
scans them quickly enough to detect even fairly high 
frequency .changes in vehicle position toward or away 
from the magnetic elements in the marked lane 
boundaries. In this way, a measure of the vehicle's 
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position in the lane can be obtained, even if the 
primary vehicle system is temporarily not working. 
Further, while FIG. 9 shows magnetometers mounted to the 
front of the vehicle, they can be mounted to the rear as 
5 well. This would allow an optional calculation of the 
vehicle's yaw angle relative to the magnetic strips. 

FIG. 10 is a block diagram of another 
embodiment of the present invention. All items are the 
same as those illustrated in FIG. 1 and are similarly 

10 numbered, and operate substantially the same way. 
However, rather than providing an output to display 22, 
controller 12 provides an output to neurostimulator 300. 
Neurostimulator 300 is a stimulating device which 
operates in a known manner to provide stimulation 

15 signals to . the cortex to elicit image formation in the 
brain. The signal provided by controller 12 includes 
information as to eye perspective and image size and 
shape, thus enhancing the ability of neurostimulator 300 
to properly stimulate the cortex in a meaningful way. 

20 Of course, as the person using the system moves and 
turns the head, the image stimulation will change 
accordingly. 

It can thus be seen that the present invention 
provides a significant advancement in the art of 

25 mobility assist devices, particularly, with respect to 
moving in conditions where the outward looking field of 
view of the observer is partially or fully obstructed. 
In an earth-based motor vehicle environment, the present 
invention provides assistance in not only lane keeping, 
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but also in collision avoidance, since the driver can 
use the system to steer around displayed obstacles. Of 
course, the present invention can also be used in many 
environments such as snow removal, mining or any other 
5 environment where airborne matter obscures vision. The 
invention can also be used in walking or driving in low 
light areas or at night, or through wooden or rocky 
areas where vision is obscured by the terrain. Further, 
the present invention can be used on ships or boats to, 
~ 10 for example, guide the water-going vessel into port, 

£ through a canal, through lock and dams, around rocks or 

: 5 I 

M= other obstacles. 

Jj? Of course, the present invention can also be 

!=* used on non-motorized, earth-based vehicles such as 

" 15 bicycles, wheelchairs, by skiers or substantially any 

^ other vehicle. The present invention can also be used 

M= to aid blind or vision impaired persons. 

Although the present invention has been 
D described with reference to preferred embodiments, 

20 workers skilled in the art will recognize that changes 
may be made in form and detail without departing from 
the spirit and scope of the invention. 



